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ABSTRACT 

A robot wrist consisting of two universal joints can eliminate the 
wrist singularity problem found on many industrial robots. This pa- 
per presents forward and inverse position and velocity kinematics for 
such a wrist having three degrees of freedom. Denavit-Hartenberg 
parameters are derived to find the transforms required for the kine- 
matic equations. The Omni- Wrist, * a commercial double universal 
joint robot wrist, is studied in detail. There are four levels of kine- 
matic parameters identified for this wrist; three forward and three 
inverse maps are presented for both position and velocity. These 
equations relate the hand coordinate frame to the wrist base frame. 
They are sufficient for control of the wrist standing alone. 

When the wrist is attached to a manipulator arm, the offset be- 
tween the two universal joints complicates the solution of the overall 
kinematics problem. All wrist coordinate frame origins are not co- 
incident, which prevents decoupling of position and orientation for 
manipulator inverse kinematics. This is a topic for future research. 


INTRODUCTION 

Many current industrial robot wrists suffer from singularity limita- 
tions where at least two wrist coordinate frames align, reducing orien- 
tational freedom. Near singular positions, extremely large joint rates 
are required to maintain constant cartesian rates. One proposed wrist 
design for reducing singularities uses the universal joint to achieve 
roll, pitch, and yaw orientation. An overview of robot wrists, includ- 
ing universal joint designs, is given by Rosheim (1989). Other refer- 
ences present non-singular robot wrist designs, e.g., (Barker, 1986), 
(Milenkovic, 1987), (Rosheim, 1987 and 1986), and (Trevelyan, 1986). 

McKinney (1988) presents forward kinematic and resolved rate equa- 
tions for single and double universal joint robot wrists. The author 
studies a specific double universal joint wrist, the Omni- Wrist from 
Ross-Hime Designs, Inc. A single universal joint wrist is attractive 
because its motion is purely rotational. However, the workspace is 
limited due to gimbal lock singularities. Also, the roll velocity of the 
output shaft is variable, given a constant input roll rate. Therefore, 
a wrist with two universal joints in series is suggested, which allows 
an approximately hemispherical singularity-free workspace (McKin- 
ney, 1988). Two universal joints yield a constant roll velocity ratio 
(Mabie and Reinholts, 1987). 

The current, paper presents forward and inverse kinematic position 
and velocity equations for control of double universal joint robot 
wrists. Denavit-Hartenberg parameters are presented for double uni- 
versal joint wrists. The Omni- Wrist kinematic transformations are 
presented. Four levels of kinematic parameters are identified, from 
the actuator angles to the position and orientation of the hand. Three 
mappings are presented for each of the forward position, inverse posi- 


* The mention herein of a trademark of a commercial product does not 
constitute any recommendation for use by the Government. 


tion, forward velocity, and inverse velocity (resolved rate) problems. 
These equations relate the robot hand to the robot wrist base and 
are sufficient for control of the wrist standing alone. 

The double universal joint wrist is not purely rotational due to the 
offset between the two universal joints. Position and orientation tra- 
jectories thus may not be decoupled for a double universal joint wrist 
attached to a manipulator arm. The manipulator inverse position 
and velocity problems are more complicated for the double universal 
joint robot wrist than a purely rotational robot wrist. 
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Cartesian coordinate frame m 
Wrist base coordinate frame 
Hand coordinate frame 
Actuator angles 
Gear bail angles 
Universal joint angles 

Homogeneous transformation matrix of {m} 
relative to {n} 

Rotation matrix of {m} relative to {n} 
Element (i,j) of || R] 

Position vector from origin of {n} to {m}, 
expressed in {n} 

Unit direction vector X of {m} 
expressed in {n} 

Angular velocity of {m} with respect to {3}, 
expressed in {m} 

Linear velocity of {m} origin with respect 
to {3}, expressed in {m} 

Forward map solving $iG given 0 iA} i=4,5,6 

Forward map solving &i given dio, i=4,5,6 

Forward map solving [|T] given 0;, i=4,5,6 

Inverses of F3, F2, F 1, respectively 

Forward and Inverse velocity maps, 

defined analogously 

Joint rate i 

cosBi 

sinOi 

tanOi 

Offset length between the universal joints 


DOUBLE UNIVERSAL JOINT WRIST KINEMATICS 

A universal joint is used to transfer rotations between intersecting 
shafts. Most kinematics textbooks discuss universal joints (e.g. Ma- 
bie and Reinholts, 1987). A kinematic diagram for the double uni- 
versal joint robot wrist is shown in Fig. 1. The input shaft rotates 
about a fixed axis and the output shaft is free; thus there are five 
degrees of freedom. Coupling of 05 and 0 G reduces this number to 
three degrees of freedom. 
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Figure 1 shows the initial position for all wrist coordinate frames; 
all universal joint angles are zero in this configuration. Frame {3} is 
the wrist base frame, fixed for this paper. Frame {4} rotates by 0 4 
relative to {3}; {5} rotates by 0& relative to {4}; {6} rotates by 0 6 
relative to {5}; {7} rotates by the coupled 0c relative to {6}; and the 
hand frame {8} rotates by the coupled 0g relative to {7}. 





Figure 1 

Double Uni vernal Joint Robot Wrist 
Kinematic Diagram 


Denavit-Hartenberg Parameters 

The Denavit-Hartenberg parameters for the double universal joint 
robot wrist of Fig. 1 are given in Table I, which follows the convention 
in Craig (1988). 

Table I Denavit-Hartenberg Parameters 
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Forward Position 

The forward solution finds (JT] given 0 4 , 0g, 0c- Equation 1 is the 
homogeneous transformation matrix describing the position and ori- 
entation of (t) with respect to {t — 1} (Craig, 1988). 
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Five homogeneous transformation matrices relating {3} through {8} 
are obtained by substituting the Denavit-Hartenberg parameters into 
Eq. 1. 
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The general forward kinematics solution is Eq. 2. The (4x4) forward 
transform is comprised of a (3 X 3) rotation matrix representing the 
orientation and a (3 X 1) position vector locating the origin of {8} in 
{3}. The specific terms are given in Eq. 3. 
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Inverse Position 

The inverse problem solves for the universal joint angles given task 
space input. The full [gT] cannot be specified because it has six 
freedoms, and the wrist only three. Due to the following constraint, 
which dictates that { 3 Pg} travel on the surface of a sphere of radius L, 
{3p 8 } cannot be the input, because it has two independent freedoms. 


Pi + Pi + Pi = L 2 
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The rotation matrix \lR\ is the input to the inverse problem. 


r n 

*"13 

*"13 

f21 

*"22 

*"23 

rai 

*"32 

T33 


HR] = 1 |ifl(«»)] IS*(M] [?S(fie)l [[*(«»)! 

The angle 0 4 is isolated by inverting [ 4 /?] and multiplying it on the 
left of both sides of Eq. 5. 
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The angles 0& and 0 G are eliminated from the right hand side of Eq. 
6 by equating the (1,1), (2,3), and (3,2) elements, given in Eqs. 7, 8, 
and 9, respectively. 
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r 2 ic 4 - rn3 4 = -2slc% + 1 
-ri3C4 ~ **2334 = -2cg + 1 

r 32 = 2c^c^ - 1 

Equation 7 is subtracted from Eq. 9 to eliminate 0 6 . 

r 32 - r 2 ic 4 + rn5 4 = 2 c§ - 2 
Equations 8 and 10 are added to remove Oq. 

EcoS$4 + + G — 0 

E = -(r 13 + r 2 i) 
F — rn — r 23 
C7 = r 32 + 1 


(7) ^he P ro P € r sign for 2 0 3 is chosen from Eq. 18. Another valid solution 

/o\ ^ or 2^6 is 20 o + 2?r; therefore, a second mathematical solution for 0 O 

V ' is 0 G + X. 

(9) 

A generalization is drawn regarding the two solutions for 0 5 . The 
right hand side of Eq. 18 for 0 6 + x is the negative of that value for 
6 b . Therefore, the value of 0 G corresponding to 0 b + x is the negative 
of 0 G corresponding to 0 6 . 

(i®) There are four solutions to the inverse problem: a unique O 4 , two 
0 B for this O 4 , plus two Oq for each $5. Only one combination need 
be solved} the remaining three are formed from the structure of the 
solution, summarized in Table II. In rows 1 and 2 of Table II, 0 G can 
be positive or negative; the negative 0 G in rows 3 and 4 indicates 
opposite sign to Oq of row 1 . 
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Table II Inverse Position Solutions 


Using the tan half angle substitution (Mabie and Reinholtz, 1987), 
there are two solutions for #4: 


Solution $4 0 b Oq 


0 4l . a = 2tan 1 


-F ± y/E 2 + E 2 - G 2 
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( 12 ) 


The radicand in Eq. 12 is simplified with orthonormal constraints. 
The columns of [gR] are the X , Y, Z unit vectors of {8} expressed in 
{3} coordinates, while the rows are those of {3} given in {8}. The 
orthogonal constraints dictate that both the columns and rows of 
a rotation matrix form a dextral mutually perpendicular set. The 
normal constraints dictate that the length of all columns and rows is 
unity. With the following four constraints, E 2 + F 2 — G 2 = 0. 


1 #4 05 06 

2 04 05 0 G + n 

3 04 05 + 7T -0 G 

4 04 05 + X - 0 q+ It 


Forward Velocity 

The forward velocity problem solves for cartesian rates given joint 
rates using velocity recursion equations (Craig, 1988). 


3 ?s = 3 £ 8 x 3 * g 
| 8 *3 | = 1.0 
| 3 f-»| = 1.0 
\ 8 y 3 \ = 1.0 


Therefore, given [gR], there is one solution to 04 (two repeated roots), 
from Eq. 12. 
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With 04 solved, the left hand side of Eq. 6 is known. The next step 
is to isolate and solve 0 5 . 
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The (2,2) elements of Eq. 15 are equated to solve 0 5. 
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Both solutions from the inverse tangent function are mathematically 
valid, due to symmetry: 0 5 < 0 6 < =£-) and 0 5 + x. When 0 4 . 

and 0 5 are known the left hand side of Eq. 15 is known. Angle 0 O is 
solved by equating the (3,2) elements of Eq. 15. 


206 = COS 1 (r 13 c 4 + r 23 3 4 ) (17) 

The inverse cosine function solution is ±20 G . This ambiguity is re- 
solved by determining which sign satisfies the (1,2) terms of Eq. 15. 
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The wrist Jacobian matrix is extracted from the forward velocity 
solution. The (6 x 3) Jacobian matrix maps the (3 x 1) joint rates 
into the (6 X 1) cartesian rates. The Jacobian matrix is partitioned 
into (3 x 3) rotational and translational Jacobian matrices, [/r] and 
\ J t\- 
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Inverse Velocity (Resolved Rate) 

The resolved rate problem solves for joint rates given cartesian rates. 
This problem is overconstrained (six equations in three unknowns). 
Therefore, only three cartesian rates may be specified. The resolved 
rate input cannot be { 8 vg} because [Jj>] is always singular. This is 
due to the constraint, Eq. 4. 


s20 6 — (r 23 c 4 — r 13 s 4 )s5 — r 33 cs (18) 


|Jr| = £s 6 s 6 c£(l - c\ - s|) = 0 (23) 
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The inverse velocity problem is solved by inverting Eq. 21. 
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The wrist singularity conditions are found by setting the determinant 
to zero. 


|J*| = 4c 6 c?=0 (25) 

The double universal joint robot wrist is singular when 0 & = ± | or 
0 c = ±*. 

OMNI- WRIST KINEMATICS 

The Omni- Wrist by Ross-Hime Designs, Inc. is a double universal 
joint robot wrist. Figure 2 displays a section view of the Omni- Wrist. 
Planetary gears transfer the first universal joint rotations 65 and 0 G 
to the second universal joint. 

The rotational axes for 0 6 and 0 G are moving. The Omni- Wrist has 
outer and inner bevel gear bails to transfer rotations from two actu- 
ators fixed in the wrist base to the angles #5 and 0 G , to avoid moving 
actuators. No intermediate gear bail is required for 64 because it 
rotates about an axis fixed in the wrist base. In addition to the outer 
and inner gear bails, helical gear trains are used to reduce the speed 
and amplify the torque for each of the three actuators. 

Referring to Fig. 2, actuator 1 drives £4. The inner gear bail rotates 
in the plane of the paper; the outer rotates about a perpendicular 
axis. The inner gear bail angle, rotated by actuator 2, equals 0 G 
when 04 = 65 ~ 0. Actuator 3 rotates the outer gear bail, whose 
angle equals 0$ when $4 = 0 G = 0- In general, the inner and outer 
gear bails combine to yield 0& and 0 G . 



The roll angle 64 is continuous and bidirectional. The inner and outer 
gear bail angles are limited to ±45°. These limits apply to 0& when 
$ 4 = = 0, and to 0 G when 0 4 = 0 5 = 0. When these angles are not 

zero, the limits on 0 5 and 0 G are more restrictive. 

There are four levels of Omni- Wrist kinematic parameters: 1) Ac- 
tuator angles { 04 A, 9qa)\ 2) Gear bail angles (0 4 t?, 050, 06<?)l 3) 

Universal joint angles (0 4 , 0&, 0 G ); and 4) Hand coordinate frame [gT]. 
All angles are zero in the initial position. 


Omni- Wrist Position Kinematics 

Figure 3 describes the three forward and inverse position mappings 
between the four levels of Omni- Wrist kinematic parameters. The 
overall forward position problem finds [gT] given the actuator angles, 
using maps Fl, F 2, and F 3. The inverse position problem finds the 
actuator angles given [gT?] via the maps Jl, 72, and 73. 



Figure 3 

Position Mappings 


Maps F 3 and 71 are the general wrist solutions, Eq. 3 and Eqs. 14, 
16, and 17, respectively. The remaining maps are developed in this 
section. 


Position Maps Fl and 73 

The gear bail angles are related to the actuator angles by gear trains. 
Forward map Fl is given in Eq. 26. 


04 a = Wi 04 A 

(26a) 


(266) 

0 q<; = A r 3 0 6 >i 

(26c) 

For the Omni- Wrist, N\ — 77773, W 2 = 2502’ 
map 73 is the inverse of Eqs. 26. 

•w! N\ = 2^75- The 


Position Maps F 2 and 72 


The kinematic relationships between the gear bail angles and the 
Figure 2 universal joint angles are coupled and transcendental. McKinney 

Omni-Wriut Section View (1988) solved a problem equivalent to 72; the map F2 was not solved. 
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Two coordinate frames are introduced to determine the kinematic 
relationships between the gear bail and universal joint angles. The 
{IGD} frame is attached to the inner gear bail, and {OGD} is at- 
tached to the outer gear bail, as shown in Fig. 4. Both origins are 
colocated with the origin of {3}. In the initial position, {3}, {IGD}, 
and {OGD} are coincident. The inner gear bail rotates by angle 6$g 
about the fixed axis $igd\ the outer gear bail rotates about the fixed 
%ogd by Q*>g. 



Using Eq. 29 in Eqs. 28a, 6 , and c, the following equations result. 
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The sin06 term is eliminated from Eqs. 30a and 6 to solve for 


Bq = stn *(u) 


A + Bt 4G 




( 31 ) 


The inverse sine function yields 0 G and x — the latter is out of the 
motion range of the Omni- Wrist. With 6$ known, the solution for 6 5 
comes from Eq. 30c. 


= COS 1 (v) 



(32) 


The inverse cosine function solution is ±0&. Since both results are 
potentially in the motion range of the Omni- Wrist, this ambiguity 
must be resolved by choosing the Os sign which satisfies Eq. 306. 
Map F 2 is unique. 

The mapping 12 solves for the gear bail angles given the universal 
joint angles. The 0 4G mapping is Eq. 29. The remaining gear bail 
angles are found by dividing Eqs. 286 and 28a by Eq. 28c. 


From Fig. 1 , the offset vector from the first to the second universal 
joint is a length L along (denoted { 3 P g }). The moving axes %igd 
and Yogd are perpendicular to { 3 P g } for any wrist motion. 

■fr %IGD X ?ogd 

c = 17 — 77 — f (27) 

\AlGD X Yogd\ 

The terms for Eq. 27 follow, expressed in { 3 }. 
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Both results from the inverse tangent function are mathematically 
correct, due to symmetry. However, considering angular limits of the 
Omni- Wrist, only quadrant I or IV results are admissible. Therefore, 
the inverse map 12 is unique. 
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Substituting these terms yields three scalar equations relating the 
gear bails and universal joint angles. 


Omni- Wrist Velocity Kinematics 

Figure 5 shows the three forward and inverse maps relating the four 
levels of Omni- Wrist velocity parameters. The forward velocity prob- 
lem finds the cartesian rates given the actuator joint rates, using 
maps FV 1, FV2, and FV 3. The inverse velocity problem accepts 
{ 8 w g } and calculates the actuator joint rates via maps /VI, /V 2 , 
and IV 3. 

The velocity maps FV 3 and IV 1 are Eqs. 21 and 22, and Eq. 24, 
respectively. The remaining Omni- Wrist velocity solutions are pre- 
sented below. 
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Velocity Maps FV 1 and IV 3 


= c 4 s G + S 4 S 5 C 0 — K 1 

(28a) 

The map FV 1 is a time derivative of Eqs. 

26; TV 3 is the inverse of 

= S 4 S 0 - C 4 S 5 C 0 = K 2 

(286) 

Eqs. 34. 
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0 4 G = -Vl 

(34a) 

= yJcos 2 9s G + sin‘ 2 $sGCos 2 OQG 

(28d) 

OhG = ^2^5 A 

(346) 


Equations 28a - 28c are used to find the mappings F2 and 12. 

The angle 0 4 does not have a gear bail; the F 2 mapping is identity. 


Oqg = N 3 & 6 A 


(34c) 


04 = 0417 


( 29 ) 
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Figure 5 

Velocity Mappings 


The derivatives Eqs. 36, 38, and 39 hold for the angle range ~ 1 to 
f . The sign of 0 5 in Eq. 37 is positive when — jt < 0$ < 0. 

EXAMPLES 

This section presents two examples to demonstrate the equations de- 
rived in this paper. The first example deals with the forward and 
inverse position and velocity problems for the general double uni- 
versal joint robot wrist mechanism. The second presents forward 
and inverse position and velocity results for the Omni- Wrist. The 
dimensions used in this section are mm, degrees, and 

Example 1 
Forward Position 

Given 0 4 = 120.0°, $ 5 = -25.0°, 0 O = 10.0°, and L = 41, (?T) is 
calculated using Eq. 3. 


'—0.494 -0.798 -0.345 -18.3“ 

[3 T] _ -0.452 -0.103 0.886 -2.4 

-0.743 0.593 -0.310 36.6 

. 0 0 0 1 . 


(40) 


Velocity Maps FV 2 and IV 2 

The map FV 2 is a time derivative of F2 , Eqs. 29, 31, and 32. The 
angular rate 0 q is required for the 6 5 calculation. 

04 = ho (35) 


Inverse Position 

Given [|j R] from Eq. 40 three universal joint angles are calculated 
with Eqs. 14, 16, and 17; the four solutions are formed from Table 
II. 
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G = + c^as^a^bG + 6< ^° G M j 

inverse map IV 2 is a time derivative of 12, Eqs. 33a and 336. 
! mapping for 0 4 <; is Eq. 35. 


1 + u; 2 dt 

— — (c 4 t 0 + S 4 a 6 )0 4 + “2(04 -1- S 4 S 5 tfl )^6 2 ( 3 <)^0 

dt C 5 Cg c 5 Cq 


A _ 1 d( i 
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Table III Inverse Position Solutions 


Solution 

*4 

06 

00 

1 

120.0 

-25.0 

10.0 

2 

120.0 

-25.0 

190.0 

3 

120.0 

155.0 

-10.0 

4 

120.0 

155.0 

170.0 


Forward Velocity 

Given 0 4 = 1.0, 0 5 = 2.0, 0 C — 3.0, and L = 41, {“^g) and { 8 t>g} are 
calculated using Eqs. 21 and 22. 

f 4.4 ) ( -80.0 ) 

{%.} = { 3.7 } {%„} = { -10.0 (41) 

{ 3.6 J { 100.0 J 


Inverse Velocity (Resolved Rate) 

Given { 8 <j 8 } from Eq. 41, 0 4 - 1.0, 0 b = 2.0, 0 O = 3.0, are calculated 
using Eq. 24. 


Example 2 
Forward Position 
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Given the actuator angles, the gear bail angles, universal joint angles, 
and (JT) are calculated successively, using maps Fl, F2, and F 3. 
Example 1 presents the F 3 result. 
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Inverse Position 
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CONCLUSION 

This paper presents kinematic equations for control of a double uni- 
versal joint robot wrist. The forward and inverse position and veloc- 
ity problems were solved. The Omni- Wrist equations were developed 
in detail. This wrist has four levels of kinematic parameters. Three 
forward and inverse position and velocity maps relating these param- 
eters were presented. These equations relate the hand coordinate 
frame to the wrist base coordinate frame, and are sufficient for con- 
trolling the wrist standing alone. All pertinent kinematic equations 
were derived; any specific control algorithm will not require all of the 
equations. All Omni- Wrist solutions are unique. The Omni- Wrist is 
completely singularity-free throughout its range of motion. 

The equations of this paper have been verified by computer simula- 
tion. As demonstrated by the examples, the inverse solutions validate 
the forward solutions. Experimental work using the Omni- Wrist is 
planned to further validate the equations. 

The offset, L , between the two universal joints complicates the inverse 
kinematics problems when the double universal joint robot wrist is 
attached to a manipulator arm. The wrist coordinate frames are not 
all colocated, which prevents decoupling of the hand coordinate frame 
position and orientation. For a three degree of freedom manipulator 
arm carrying the double universal robot wrist, the inverse position 
problem involves six transcendental equations, coupled in the six un- 
knowns. The associated Jacobian matrix is fully populated, which 
means the hand linear velocity depends on the wrist rates in addition 
to the first three joint rates. The kinematics of a manipulator using 
the double universal joint robot wrist is a subject for future research. 
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